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1.  INTRODUCTION 


The  mathematical  analysis  and  data  reduction  techniques  described  in  this 
report  were  developed  in  conjunction  with  our  role  as  data  support  personnel 
tor  the  proposed  rocket  flight  A35.191-4  whose  flight  profile  has  two  major 
phases  during  which  experimental  measurements  will  be  taken.  Our  principal 
participation  in  this  project  is  to  provide  necessary  programming  ana  analytic 
support  to  determine  the  attitude  and  other  requested  information,  using 
chiefly,  the  on-board  attitude  measuring  systems. 

The  primary  experimental  mission  of  this  proposed  flight  is  the  Earth  Limb 
Experiment  (ELE),  which  requires  extremely  accurate  attitude  information.  To 
attain  the  necessary  attitude  accuracy  for  the  ELE,  the  attitude  measuring 
system  for  this  portion  of  the  flight  consists  of  an  Adcole  High  Resolution 
Digital  Solar  Aspect  System  Model  15380-1,  a Star  Mapper,  and  Honeywell  Rate 
Integrating  Gyro.  Transformations  of  coordinate  systems,  analysis,  and  data 
reduction  were  developed  which  would  be  used  to  calculate  the  vehicle's  attitude 
from  the  on-boara  attitude  sensing  devices.  The  attitude  will  then  be  used  to 
determine  tangent  height. 

After  the  ELE  scans  have  been  completed,  the  solar  aspect  sensor  is  re- 
orientated and  the  vehicle  itself  torqued  to  a new  predetermined  orientation 
to  start  the  zodiacal  scan.  The  precise  knowledge  of  this  orientation,  however, 
does  not  meet  the  requested  attitude  accuracy  requirements.  Accurate  knowledge 
of  the  orientation  of  the  vehicle  for  the  start  of  the  zodiacal  scan  is 
essential  since  the  initial  attitude  for  the  zodiacal  scan  will  be  calculated 
using  gyroscopic  and  Rate  Integrating  Gyro  (RIGj  outputs  whose  zero  reference 
will  be  this  new  orientation. 

The  attitude  for  the  initial  point  at  the  start  of  the  scan  will  be 
calculated  from  the  preselected  orientation  of  the  rocket,  updated  by  correction 
factors  established  during  the  ELL  scans.  Using  this  initial  estimate,  sun 
sensor  and  gyroscopic  data  available  in  a neighborhood  of  this  initial  point, 
the  Kalman  filter  will  be  used  to  update  this  initial  point  after  the  initial 
point  Has  been  determined,  attitude  during  the  scan  will  be  computed  using  gyro 


ind  Kill  information.  Similar  Lo  the  ELI:  portion  ol'  the  flight,  the  Knlnuin 
filter  will  be  used  in  sequential  fashion  to  calculate  attitude  updates  based 
on  the  sun  sensor  data. 

Digital  tapes  and  printouts  containing  updated  attitude  and  requested  cal- 
culations based  on  attitude  information  along  with  an  estimate  of  the  possible 
error  in  the  data  will  be  supplied  as  final  outputs  of  this  project. 


. FUNCTIONAL  DESCRIPTION  FOR  ATTITUDE 


To  provide  extremely  accurate  attitude  information,  not  only  during  the 
F.Lt  operational  periods  but  also  during  other  portions  of  vehicle  lifetime, 
six  reference  coordinate  systems  must  be  introduced.  These  systems  are  required 
because  ol  the  vehicle's  flight  profile  and  on-board  attitude  measuring  systems. 
A discussion  of  the  attitude  measuring  systems,  the  flight  profile  and  the 
reference  coordinate  systems  follows. 

2.1  Attitude  Sensing  Systems 

The  primary  attitude  determination  system  is  comprised  of  a star  mapper, 
sun  sensor  and  Rate  Integrating  Gyro  (RIG).  This  system  will  provide  necessary 
attitude  information  during  the  FLE  operational  period.  The  secondary  attitude 
determination  system  is  an  Attitude  Control  System  (ACS)  which  is  comprised  of 
a Roll  Stabilized  Platform  (RSP)  with  two  free  gyros,  which  measure  vehicle 
yaw,  pitch,  and  true  roll  and  three  rate  gyros.  The  ACS  system  is  used  during 
the  transition  phase  to  maneuver  the  vehicle  to  its  predetermined  orientation 
so  that  all  experiments  will  point  in  their  required  directions. 

2.2  Flight  Profile 


The  ASS. 191-4  vehicle  should  behave  like  a normal  well-behaved  rocket 
until  04  seconds  after  launch  when  the  ACS  is  activated.  After  receiving  a 
start  signal,  the  ACS  initiates  yo-yo  despin  and  payload-vehicle  separation. 

After  separation  the  payload  roll  position  is  brought  into  alignment  with  the 
roll  gyro  reference  (roll  capture).  While  roll  capture  is  in  progress,  pitch 
and  yaw  rates  are  brought  to  zero  under  control  of  the  rate  gyros.  Payload 
pitch  and  yaw  attitude  are  aligned  with  the  gyro  references  following  roll 
capture  (three-axis  capture).  A set  of  "remote  adjust"  maneuvers  in  roll,  pitch, 
and  yaw  is  performed  following  initial  alignment  of  the  payload  with  the  gyros. 
Upon  completion  of  the  remote  adjust,  the  payload  sensor  axis  is  aligned  to 
the  preprogrammed  orientation  from  which  the  first  of  the  FILE  scans  begins.  It 
is  to  be  noted  that  the  average  error  due  to  the  torquing  on  the  yaw  and  pitch 
axes  is  1.6°  as  established  from  previous  Ili-Star  flights. 

The  telemetered  attitude  data  will  be  corrected,  when  possible,  for  system- 
atic errors  inherent  to  the  sensor  measuring  system.  These  errors  will  be 
determined  from  the  study  of  the  various  attitude  sensors'  specifications,  i.e. 
gyro  bias  drift.  The  angle  between  the  sun  line  vector  and  the  center  line  of 


the  sun  sensor  will  be  predicted  and  compared  with  actual  sun  sensor  angular 
readout.  The  attitude  will  be  updated,  when  necessary,  using  the  results  of 
this  comparison.  Further,  the  attitude  determination  during  the  ELE  scans 
makes  it  possible  to  readjust  the  preselected  orientations  of  the  rocket  given 
at  the  start  of  a scan  and  could  possibly  provide  error  correction  factors 
which  would  enable  additional  preselected  orientations  to  be  corrected. 

There  will  be  four  vertical  F.LE  scans,  each  in  a Northerly  direction,  in 
a manner  such  that  Polaris  will  be  detected  by  the  star  mapper  on  each  scan. 

The  attitude  of  the  rocket's  scanning  axis  will  be  determined  during  each  scan 
by  combining  the  discrete  measurements  of  the  star  mapper  and  solar  aspect  sen- 
sor and  integrating  them  with  the  RIG  rate  of  change  information  for  this  axis. 
Tne  attitude  analysis  has  been  developed  assuming  that  all  ELE  scans  will  be 
in  a vertical  plane.  Any  deviations  or  changes  will  cause  modifications  in 
our  analysis. 

After  ail  ELE  scans  are  completed,  the  sun  sensor  will  be  re-oriented  and 
the  vehicle  torqued  to  a new  preselected  orientation  so  that  a scan  (zodiacal) 
for  another  experiment  can  be  performed.  The  ACS,  comprised  of  the  RSP  with 
two  free  gyros,  three  course  rate  gyros  (one  on  each  of  the  measuring  axes) 
and  two  accurate  rate  integrating  gyros  (one  on  the  pitch  axis,  the  other  on 
tne  yaw),  will  be  used  in  conjunction  with  the  outputs  from  the  sun  sensor  to 
determine  the  most  accurate  attitude  possible  during  the  zodiacal  scan.  Since 
the  gyros  as  well  as  the  vehicle  are  torqued  to  a new  orientation  at  the  start 
of  the  zodiacal  scan,  thus  determining  a new  gyro  zero  reference,  this  orienta- 
tion must  be  known  as  accurately  as  possible.  The  preselected  orientation  of 
the  rocket  will  be  used  at  the  start  of  this  scan  as  the  attitude  of  the  rocket, 
and  will  oe  updated  by  correction  factors  established  during  the  ELE  scans. 

once  tne  best  estimate  of  tins  orientation  has  been  determined,  the  attitude 
will  be  calculated  by  standard  attitude  analysis  for  gyroscopic  data.  However, 
the  data  reduction  analysis  of  the  gyro  data  will  have  to  be  modified,  since 
during  tins  scan  tne  vehicle  pitches  outside  the  calibrated  limits  of  the  instru- 
ment. ihis  vehicle  motion  causes  the  output  of  the  pitch  signal  to  be  saturated 
an  i to  remain  so  while  the  vehicle  is  pitching  outside  the  pitch  axis  cal incut ion 
i ihis  problem  will  be  corrected  by  utilizing  the  outputs  of  the  pitcr. 

RIG  to  produce  continuous  angular  pitch  values  during  this  s..turateu  period. 

This  technique  entails  using  the  pitch  angular  value  before  it  is  saturated  and 
adding  to  it  tne  output  of  the  pitch  RIG,  i.e.  , 


pitch  (,t^+ , = pitch(.t^J  + pitch  Rlti(tj.)  + E_ 


where  E0  is  the  error  estimate. 


Using  this  approacn  in  areas  in  which  the  pitch  angular  output  is  not 
saturated,  we  will  compare  results  and  hence  determine  the  error  estimate. 

This  data  reduction  technique  will  then  allow  us  to  use  the  gyroscopic  attitude 
determination  analysis  mentioned  above. 

To  update  the  attitude  during  the  zodiacal  scan,  the  sun  sensor  output  will 
be  used.  This  procedure,  similar  to  that  mentioned  for  the  ELE,  involves  a 
comparison  of  the  predicted  and  measured  angle  between  the  sun  line  vector  and 
orientation  of  the  sun  sensor  axis. 

If  we  let  P be  the  orientation  of  the  sun  sensor  probe  axis,  given  in  the 
fixed  inertial  system  (I  J K)  by 

P = I cos0  cos*  + J cos0  sin*  + K sm0 
P P P P P 

and  the  unit  sun  line  vector  as  derived  from  empirical  sources  given  by 


S - 1 cos0  cos*  + J cos0  sin*  + K sin0 
s s s Ts  s 


0 is  the  declination  of  the  sun 
s 

is  the  right  ascension  of  the  sun. 


then  y,  the  angle  between  P and  S is 


V = cos  1(P*S)  = cosO^.  cosG  cos(*-*  ) + sin0  sinOs 


Tnis  predicted  value  is  compared  with  the  measured  sun  sensor  output.  Then 
the  attitude,  if  needed,  will  be  adjusted  within  an  established  error  bar  to 
achieve  the  best  possible  comparison. 


2.3  Reference  Systems 
2.3.1  Fixed  Inertial  System 


The  most  basLC  of  the  six  reference  coordinate  systems  to  be  used  is  the 

fixed  inertial  system  (.1  J KJ.  1 is  a unit  vector  in  the  direction  of  the 

autumnal  equinox  and  lying  in  the  equatorial  plane  of  the  Earth,  K is  a unit 

vector  in  the  direction  of  the  Earth's  North  Pole  and  J * K x I.  This  system 

is  fixed  in  space,  and  the  position  vectors  representing  the  sun,  Polaris,  and 
hopefully,  preprogrammed  orientations  are  to  be  given  in  this  (1  J K)  system. 

2.3.2  Vehicle  System  at  Launch 

a second  reference  coordinate  system  to  be  used  is  a right-handed  body 

AAA  A 

vehicle  system  (Xq  Yq  Zq) . Xq  is  a unit  vector  along  the  vehicle's  roll  axis, 

Y is  a unit  vector  along  the  vehicle's  pitch  axis,  and  Z = X x Y where  Z 

0 b '*0  0 0 0 

is  along  the  vehicle's  yaw  axis.  All  attitude  systems  on  board  the  vehicle 

^ A. 

output  with  respect  to  this  (X  Y Z ) system.  Also,  the  orientation  of  each 
on-board  probe  is  initially  referenced  to  the  (Xq  Yq  Z system. 

2.3.3  Local  Launcher  System 

A third  coordina;  system  to  oe  used  is  the  local  launcher  vertical.  East, 

AAA  A 

and  North  system  (V  E N) . N is  a unit  vector  tangent  to  the  meridian  circle 

A 

througn  the  launcher  and  pointing  to  true  North,  E is  a unit  vector  tangent  to 

/A 

the  circle  of  latitude  through  the  launcher  and  pointing  East  of  North,  and  V = 

E x N.  Since  the  gyro  system  is  uncaged  in  the  launcher  whose  position  is  given 

AAA 

in  this  (V  E N)  system,  reference  to  this  coordinate  system  is  required  in  order 
to  provide  a history  of  the  vehicle  flight  from  lift-off  to  despin  and  the  space- 
car  ft's  subsequent  motions. 

2.3.4  Ecliptic  inertial  System 

A fourth  reference  system  is  an  ecliptic  inertial  (I  J K ) . The  ecliptic 

c c c 

plane  determined  oy  the  ortnonormal  vectors  1^  and  J is  defined  as  the  plane 
ot  the  Eartn's  orbit  about  the  sun.  Referring  to  the  fixed  inertial  system, 

1 ~ I and  K makes  an  angle  e with  K.  The  angle  of  obliquity  c - 23°  27'  S.2" 

- . 4b»4 (t-i900J ",  t - the  year  in  question  and  ,J  = X x I . 

2.3.s  Geocentric  System 

An  intermediate  reference  system  to  be  used  is  the  geocentric  system  vi  j k, 


with  1 and  j unit  vectors  in  the  equatorial  plane  oi  tne  Lartii  and  i in  the 
direction  of  tne  Greenwich  Meridian  Plane.  The  unit  vector  k is  in  the  direction 
of  tne  Larth's  North  Pole  and  k 1 x j. 

Z.S.o  Uncaged  Vehicle  System 

Another  intermediate  reference  system  to  he  used  is  the  (X  Y Z)  orthonormal 
system  which  positions  the  vehicle  axis  X with  respect  to  the  caged  system 
(X  Yq  . Using  gyro  yaw,  pitch  and  roll  information,  a transformation  matrix 
will  be  developed  ia  Section  6 to  transform  this  uncaged  system  to  other  required 
reference  systems. 
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3.  DATA  FLOW  FOR  A35. 191-4  (ELE/ZODiACAL) 


The  data  flow  commences  with  processing  the  digital  tapes  containing  the 
attitude  information  into  meaningful  engineering  units.  This  data  is  then 
corrected  for  any  systematic  error  inherent  to  the  attitude  measuring  systems. 

As  previously  discussed,  the  attitude  for  the  vertical  scans  of  the  ELL 
will  be  calculated  using  the  outputs  of  the  sun  sensor,  star  mapper,  and  RIG 
which  is  mounted  on  the  scanning  axis.  This  attitude  determination  will  be 
constantly  updated  using  the  sun  sensor  information  and,  further,  will  allow 
tne  preselected  orientation  for  the  start  of  the  ELL  scans  to  be  updated. 

This  final  attitude  data  will  be  combined  with  the  ephemeris  data  to  calculate 
tangent  height. 

Since  the  vehicle  and  gyros  are  torqued  to  a preselected  orientation  for 
the  start  of  the  zodiacal  scan  and  since  the  initial  attitude  for  the  zodiacal 
scan  will  be  calculated  using  gyroscopic  and  RIG  outputs  whose  zero  reference 
will  be  this  new  orientation,  it  is  essential  for  accurate  attitude  informa- 
tion during  the  zodiacal  scan  that  this  orientation  be  accurately  known. 
According  to  a previous  discussion,  updates  on  this  preselected  position  will 
De  made  by  criteria  established  during  the  ELE  scans,  and  the  initial  attitude 
information  calculated  for  the  zodiacal  scan  will  be  updated  using  the  sun 
sensor  output.  The  final  attitude  for  the  zodiacal  scan  will  be  represented 
in  an  inertial  ecliptic  system. 


JAVA  ii.OK  t-UR  A3S.  i-Al-4  tVLii/VODlACAL) 


ATTITUDE  DETERMINATION  WITH  UPDATES 
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COORDINATE  TRANSFORMATIONS** 


Local  Vertical 
East,  True 
North 


4. 


TANGENT  HEIGHT  GALCULAT  )1< 


The  coordinate  system  to  find  tangent  heigi.t  i ■.  tin*  lived  inertial  .ystem 
(I  .J  k ) where  I is  a unit  vector  m the  direction  oi  the  vernal  equinox  and 
lying  in  the  equatorial  plane,  k is  a unit  vector  in  tne  direction  of  the 
Earth's  North  Pole,  and  J k x 1. 

The  tangent  height  is  calculated  witn  re  Terence  to  this  (I  .1  k)  system  by 
the  orientation  of  the  scanning  axis  X and  vehicle  altitude  ; com  the  center  of 
the  Earth. 

X is  represented  as 


X c 1+mJ  + nk 
x x ,\ 

wrtere  <.  , in  , n are  the  attitude  determined  direction  cosines  of  the  scanning 
XXX 

axes.  The  distance  R from  the  center  of  the  Earth  to  the  vehicle  is  given  by 
tne  expression 


R x 1 + y .1  + z k. 

P P P P 

The  equation  for  any  point  on  the  oblate  spheroidal  Earth  model 

is 

> ? 1 

X-  1-  y " + z~  - 1 

■>  V 

b“  c“ 

where  b and  c,  the  equatorial  and  polar  radii  respectively,  are 

i)  b.378.388  km. 
c - ti356.912  km. 


Then,  for  some  point  x . . 

h ' T 

center  of  the  Earth  to  this 


on  the  Earth's  surface, 
‘i 

point  can  be  represented  as 


the  vector  from  the 


Figure  1 

Since  the  gradient  is  normal  to  the  surface  <j>(x,y,z)  = constant  through 
each  point  on  the  surface*,  a normal  N to  the  spheroidal  model  at  x^,  y z^ 
and  to  the  scanning  axis  is 


An  attitude  dependent  expression  for  N can  be  defined  as 


N 


X x 


(R  x X) 
P 


x X| 


1 


since  N is  perpendicular  to  X and  in  a plane  parallel  to  the  plane  of  R and 
X.** 


Phillips,  Vector  Analysis,  pg.  35. 

* ★ 

Phillips,  Vector  Analysis,  pg.  17. 
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Summing  the  vectors  in  Figure  i,  we  get 


k + sX  - hN  - R =0 
P 4 


(4-1) 


Since  X is  perpendicular  to  N, 


X • N * 0 


Taking  the  scalar  product  .r  (.4-1)  with  X and  N respectively,  we  find  that 


s - X • (R  -R  ) 
4 P 


h = N • (R  -R  ) . 

P q 


Given  the  attitude  of  X and  the  position  vector  Rp  in  the  fixed  system,  the 
distance  s in  the  X direction  from  tiie  rocket  in  trajectory  to  N and  the 
tangent  height  h are  completely  determined  and  can  be  rewritten  as 


(b*-c2)  nx  [nx(Rp.X)  - sp) 


y ,»y2  - cy^; 

fb2  - (b2  -c2 ) [z  -n  (R 


(R  *X) 
P 


i1--  * 1’ 

K i 2 - ( K -X)2 

n > n J 


h ^ . “,2  - («  -X)2 


* 


lD2-c2J  [zp-nx(Rp-X)]2 
Rp  : - CRP’^2 


Let  the  direction  cosines  of  X when  the  distance  s=0  be  given  by  l , m , 

o o 


X = K.  I * m J + n k, 
ox  x x 

o o o 


i s 


and  define 


then  the  scan 

6 = cos 


angle  6 (Fig.  1)  tor  any  other  direction  X is 


- 1 (5C*X  ) = cos'l(*x  *x  + \ mx  + n~  • 


X X 

o 
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STAR  MAPPER  COORD  1 \A  l'E  TRANS i OKMAT I UNS 


^ . 


Tne  mathematical  and  graphical  relationships  between  the  basic  reference 
coordinate  systems  are  presented  here.  Also,  any  intermediate  results  necessary 
to  produce  the  aforementioned  systems  will  be  described. 

5.1  Fixed  Inertial  System  (I  J K) 

AAA 

Since  the  history  of  vehicle  flight  is  based  upon  the  local  (.V  E N)  system, 
a transformation  to  the  fixed  inertial  (1  J k)  system  must  be  made  when  providing 
sun  and  moon  information.  The  relation  of  coordinate  systems  is  necessitated 
by  the  fact  that  sun  and  moon  data  are  provided  in  the  (1  J K)  system.  This 
transformation  can  be  separated  into  two  distinct  phases,  the  first  of  which 
relates  (V  E N)  to  the  geocentric  system  (i  j k)  and  the  second  of  which  relates 
the  (i  j k)  system  to  the  (1  .1  k)  system.  Summarizing  these  transformations 
we  have 


fv]  111 

1 

M 

U j : 

El  =A!J 

I 1 

= adI  j ! 
1 ! 

hJ  k 

k 

The  matrix  A requires  the  latitude  and  longitude  with  respect  to  the 
Greenwich  Meridian  Plane  of  the  position  on  the  fearth's  surface  to  which  data 
is  being  referenced. 


0 : latitude 
: longitude 


Figure  2 


The  matrix  L)  requires  the  coordinates  ol 
body  that  is  specified  m the  (.1  d K.)  system. 


the  sun,  moon  or  any  other 


0 : apparent  rt . ascension 
s 


/V  A A 

5.2  Vehicle  System  (Xq  Yq  Zq) 

AAA 

Given  the  elevation  and  acimuth  of  the  launcher  in  the  (V  E N)  system, 
we  can  relate  the  (XQ  Yq  ZQ)  to  the  local  system  by  the  expression 


r „ 1 

/x  ' 

; x° 

V 

A 

I Yo 

= B 

E 

1 * 

lA 

N 

where  the  B matrix  requires  the  launcher  settings. 


IS 


To  determine  the  attitude  of  an/  probe  P,  we  must  reference  the  orientation 
of  the  unit  vector  P in  the  direction  of  probe  P to  the  (X0  V0  20)  system.  The 

AAA 

matrix  G determines  the  orientation  of  P in  the  intermediate  (X  Y Z)  system,  i.e.. 


20 


5.3  Local  Vertical,  Last,  North  System  vV  t N) 


The  position  ot  the  vehicle  axis  in  the  launcher  is  given  in  the  local 

N S 

(V  L N)  system.  This  caged  position  serves  as  a starting  point  from  which  to 
provide  a history  of  the  vehicle  flight  from  lift-off  to  despin.  Utilizing 
the  transformation  matrices  already  discussed,  we  can  now  specify  any  probe  P 
in  the  (1  J K)  system;  i.e.. 


GCBAD  i J 


Lkj 


should  the  (V  E S’)  system  be  desired  as  the  reference  system  for  sun  and  moon 
data,  the  (I  J K)  system  takes  the  form 


r ~ 

• ~ 1 

j i 

V 

! 

1 

T 

. 

i f 

= (AD) 

E 

] K 

A 

N 

L j 

L J 

T 

where  (AD)  is  the  transpose  of  the  matrix  multiplication  AD. 

By  the  above  transformations,  we  can  now  provide  attitude  for  any  probe  P 

A A ^ 

either  with  respect  to  the  ( 1 J K)  system  or  the  local  (V  L N)  system. 

5.4  Ecliptic  Inertia]  System  (1  J K ) 

G c C 

In  order  to  reference  data  to  the  (1(  .J  k^)  system,  we  first  express 
the  (I  J K)  in  the  form 

r , r i 

i 1 ; K 

■ F k 

I K i i k | 

i J L j 


where  (•'  is  the  matrix  which  relates  the  base  vectors  ol  the  (I  J kj  system  to 
tne  ease  vectors  of  ecliptic  system. 


I = 1 


e : angle  of 
obliquity 

J = K x I (and 

£ £ C 

J is  not  in  the 

e 

plane  of  1 and  J) 


Figure  7 


Now,  any  probe  P can  now  be  referenced  to  the  (1£  system;  i.e.. 


P = GCBADF  J 


N 


This  (I  J k^)  system  has  been  selected  by  the  experimenter  to  be  the 
reference  system  for  the  last  portion  of  the  flight  of  A35. 191-4  during  which 
the  zodiacal  scan  occurs. 


A figure  relating  the  earth's  orbital  motion  on  the  celestial  sphere  to 
the  ecliptic  follows. 


A figure  relating  the  earth's  orbital  motion  on  the  celestial  sphere 
to  the  ecliptic  follows. 

NORTH  POLL  OF 


SOUTH  POLL  OF 
ECLIPTIC 


Figure  8 

The  mathematical  expressions  for  each  of  the  transformation  matrices 
A,  is,  C,  U F,  G foliow  in  .Section  t>. 


6.  COORDINATE  TRANSFORMATION  MATRICES 


The  transformation  matrices  to  be  developed  relate  the  following  coordinate 
systems: 

1)  local  system  - (V  E N) 

2)  geocentric  system  - (i  j k) 

3J  fixed  inertial  system  - (I  J K) 

4)  caged  vehicle  system  - (X^  Yq  Zq) 

AAA 

5}  uncaged  vehicle  system  - (X  Y Z) 
b)  ecliptic  inertial  system  - (I£  J£  K_) 


From  Figure  2 


V = i cosQ  cos (p  + j cos0  sin$  + k sin0 


E = roir  °^=  -l  sin$  + J cos* 


^ 3V 

N = -gg-  = -i  sin0  cos?)  - j sinO  sin?)  + k cos0 


Since 


then, 


1 

1 

V 

i i 

E 

= A 

J 

N 

.k. 

A 


cosO  cos$ 
-sin?) 

-sinO  cos?) 


cos0  sin?) 
cos$ 

-sinB  sin?) 


sin0 

0 

cosB 
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For  the  caged  vehicle  system,  Xq  is  along  the  vehicle's  roll  axis,  Y 


is  along  the  pitch  axis,  and  Z is  along  the  yaw  axis  with  X = 


ooo 


V T 


Z v 


o i 


Figure  9 


or 


above 

figure 

= V sin 

e + E cos  e 

cos(j  - a)  + 

N cos  e sin(~ 

A 

= V sin 

e+  t cos  e 

sm  a + N cos 

e cos  a 

= -l 

aX  _ p 
0 - -C  cos 

a + N sin  a 

cos  e 

3a 

OK 

- 0 = 

V cos  e - F 

sin  e sin  a 

- \ sin  e cos  a 

^e 

Since 


i = i 

o i 


< 


then  the  matrix  B is  defined  as 


1 


According  to  [1],  X,  Y , , Z ^ are  linear  combinations  of  the  unit  vectors 
in  the  direction  of  the  gyro  axes  and  the  transformation  matrix  C in  the 
expression 


V 

1 

X 

X , 

°j 

- 

lY 

= c 

Y | 

°| 

! 

i z 

— 

Z 1 

01 

is  weii  defined. 

To  determine  the  matrix  D in  the  expression 


i j i ■ u J 

kj  K 


we  begin  by  letting  I and  be  mutually  perpendicular  unit  vectors  such 

tnat  K = I * J = 1 x .j, 
o o 

In  Figure  Li,  I is  the  sun  line  vector  from  the  Farm  to  the  sun 
o 

and  the  apparent  right  ascension  . is  the  angle  between  the  vectors  i and  -1^. 


i ! j Ko  x bo  rough  et  al,  Procedures  m r the  Determination  ot  the  AttiK.i.i  t 

a Rocket  from  i.v  ..pic  . ■ B ton  College , Final  Report  pro; 

for  Contract  .Number  i 1DOJ8-70-C-U0  1.  (.United  States  Air  Forco,  ID  J ) . 


Since  I and  J are  in  the  piano  of  i and  J. 
o o r 


I 


Figure  12 

1 = I cos(tt-v>  ) - J sin(TT-a)  ) = -1  cosip  - J stntp 

o Ts'  s s s 

= I cos(ti-4>s  - — ) - J sin(7T-(p^  - — ) = 1 cos - ip^)  - J sin( 


J = i sino  - J cos4> 
o s s 


The  geocentric  system  involves  a translation  ot  the  IQ  JQ  K 


system 


K>|  rl 


ana 


sin  [aa C t - 1 ] 

t ) ♦ y]  ♦ J0  sin  + 2] 

m ^ ° 

1 sin  [uCt-t  )]  + J0  cos 


= I0  cos  - J0 

= 1 . cos  ■ 2 


k = K . 

Incorporating  (6-3)  with  (6-4),  we  find  that 

i = -I  [cos$s  cos  lw(t-tm)]  - sin$s  Sin  K^V11 

, „ [, if r t 'll  + cos$  sin  [>>(t-t  )]] 

. J [sin^.  cos  Lea  k c ~ r J s ra 

, = i [cos4>s  sin  Kt-tJ]  + sin<J»s  cos  Kt-tjli 

♦ J [smv's  sin  [uiCt-tJ]  - cos$s  cos 

k = K. 

After  simplifying  the  above  equations, 

; ■ -i  co»  [?s  --(t-t.))  - J t*.  * “‘‘-'.n 

• . I ,1.  lv,  * - J C0S  W»  * 

K - k . 


ana 


is[vs  ♦ 


Ht-tJl 


-sin 


1<J>  «•  U)(t-t  )i 


sin [&  ♦ “Ct-t  J 1 


-cos  (>>s  ♦ ) 


Z'J 


i- i\>m  \ igure  7 with  tiic  migLe  ot  obi  ltjuity  t ai>  delined  in  Section  2.3.4, 


J = J cost.  * K.  suit, 
e 


]i'  TT 

K„  = J cos  (e  ■**  + K sin  (e  ♦ ) 


- -J  sine  + K cose 


After  solving  (o-3)  for  J and  K,  the  transformation  matrix  F in  the 


. Agression 


- f Jc 


.in  be  expressed  as 


: 0 cose 


0 sine 


determine  the  orientation  of  a probe  P in  the  uncaged  vehicle  system 


(A  Y Z) , let 


P = C:  Y 


.acre  C is  a 1 by  3 row  matrix  and 


f r.  i r igure  o 


1 1 . . i,  impl  les  that 


P = aX  + dY  + yl 


u = cosA 
a = smA  cos  a 
y = sinA  s mp 


[cosA  iinAcos,.  siuAsinAj 
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7.  SOFTWARE  MODULES 


1 


A functional  description,  user's  guide,  and  flow  of  the  software  modules 
developed  for  the  A35. 191-4  coordinate  transformations  will  be  presented. 

The  coordinate  systems  and  their  codes  are  summarized  in  Table  1. 


SYSTEM 

1 DESCRIPTION 

CODE 

AAA 

'V  'o’  “o 

at  launch  or  caged 

1 

V,  E,  N 

local 

2 

i,  j,  k 

geocentric 

3 

1,  J,  K 

fixed  inertial 

4 

I.,  J _ , K 

e’  e’  L 

ecliptic 

5 

Table  1 

7.1  Functional  Description 

The  probe  vector  P can  be  expressed  as 


r.  1 

f " 

r i 

1 

~ “I 

1 x 

’ X 

V 

i ! 

i ! 

I 

1 yv 

! 

1 A 

j 

| 

e 

? 

= GG  : Y 

= GCB 

E 

= GCBA 

j i=  GCBAD 

J 1=  CCBADE 

J 1 

0 

! 

i 

e 

j ~ 

1 “ 

I : 

N 

k 

k j 

K I 

i 

>—  _1 

o 

L-  J 

- . 

_ J 

L J 

L 

^ A A 

where  the  (X  Y Z)  system  is  a vehicle  system  in  the  uncaged  position  and  the 
G,  G,  B,  A,  D,  1-  matrices  are  transformation  matrices. 

Since  wo  are  assuming  an  attitude  point  for  the  probe  vector  P is  known, 
tne  matrices  G and  G need  not  be  computed. 


If  we  are  given  the  attitude  of  P m system  ..ode  1 and  want  the  attitude 

in  system  code  3,  the  1 x 3 array  GC  will  be  multiplied  on  the  right  by  the 

3x3  array  BA.  This  will  provide  the  attitude  in  the  i,  j,  k system. 

If  we  are  given  the  attitude  of  P in  system  code  5 and  want  the  attitude 

in  system  code  2,  the  1x3  array  GCBADF  will  be  multiplied  on  the  right  by 

(ADF)T,  i .e. , 

(GCBADF)  (ADF) 1 = GCBADFFTDTAT  = GCB 

which  yields  the  attitude  in  the  requested  (V  E N)  system. 

Given  the  input  system  code  to  be  LI  and  the  output  system  code  L2,  a 
summary  of  the  matrix  multiplication  follows: 

1.  For  LI  < L2,  successive  multiplication  of  the  transformation  matrices 
occurs  on  the  right. 

2.  For  LI  > L2,  the  product  of  the  successive  transformation  matrices 

when  going  from  the  L2  system  to  the  LI  system  is  computed.  Let 

this  product  matrix  be  called  H,  then  the  input  attitude  array  is 

T 

multiplied  on  the  right  by  H . 

7.2  User's  Guide 

The  package  consisting  of 

Subroutine  INIT1  (E,  AZ,  TH,  PH) 

Subroutine  INIT2  (PHIS,  TM,  T) 

Subroutine  COORD  (LI,  L2) 

will  convert  the  attitude  of  a probe  from  the  LI  system  code  to  the  L2  system 
code  (Table  1).  The  argument  parameters  are  described  below: 

i)  F.  = elevation  of  rocket  axis  when  uncaged  (degrees) 

AZ  = azimuth  of  rocket  axis  when  uncaged  (degrees) 

TH  = latitude  (degrees)  at  launch 

PH  = longitude  (degrees)  pos.  east  - at  launch 
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These  quantities  are  to  be  defined  in  the  routine  calling  INITI.  IN  IT 1 
should  be  called  only  once. 

li)  PHIS  = right  ascension  (degrees) 

TM  = epheraeris  transit  time  (total  seconds  GMT) 

T = time  of  attitude  point  (total  seconds  C.MT) 

PHIS  and  TM  need  only  be  defined  initially,  but  T must  be  updated  before 
calling  INIT2. 

lii)  LI  = input  attitude  system  code 
L2  = output  attitude  system  code 

ATTIN(l),  ATTIN(2) , ATTIN(3)  direction  cosines  of  the  probe  vector  in  the 
Ll  system  (radians).  These  quantities  will  pass  from  the  calling 
routine  to  COORD  via  unlabelled  COMMON. 

ATTOUT(l),  ATT0UT(2),  ATT0UT(3)  direction  cosines  of  trh  probe  vector  in 
the  L2  system  (radians).  They  form  part  of  the  unlabelled  COMMON 
block. 

Ll,  L2  and  ATT1N  array  must  be  defined  in  the  calling  routine  and  be 
associated  with  time  T.  The  ATTOOT  array  is  the  requested  attitude  of 
the  probe  vector. 

IV)  COMMON  blocks 

b.)  C OMMCN  / D AT  A i / A ( 2 , 2 j , B(5, 3)  , F(3, 3) 

to  be  placed  in  subroutines  INITI  and  the  calling  routine. 

A,  B,  F,  are  transformation  arrays. 

bj  C0MM0N/DATA2/D (3, 3) 

to  be  placed  in  a subroutine  INIT2  and  the  calling  routine, 
u is  a transformation  array. 


c ) COMMON  i 1 ( 5 , 3 , 4 ) , ATT  IN ( 3) , ATTOUT ( 3 ) 

to  be  placed  in  subroutine  COORD  and  the  calling  routine. 


= B(1,J),  11(1. J. 2,  = A ( I , J ) , H(I,J,4)  = F(I,JJ 
ana  ii(I , J , 3)  = D(1 , JJ  . 


7.3  Software  Flow 


The  software  transformation  routines  involve  three  modules.  Hie  first 
of  these  initializes  the  time  independent  transformation  matrices,  the  second 
updates  time  dependent  transformations,  and  the  third  computes  the  direction 
cosines  of  the  probe  vector  in  the  output  system. 


MODULES 


Initialize  Time  independent] 
Transformation  Matrices 


V Read  Time 
\ and  Attitude 


i 

I 

j Update  Time  Dependent 
Transformations 


Specify  Input  and 
Output  Attitude  System 
Codes 


* 

CALL  COORD 


i * , 

Output  I 

j 
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S.  KALMAN  FILTER 


In  order  to  apply  the  Kalman  Filter  routines  to  the  attitude  determina- 
tion problem  for  A35.1‘Jl-4,  a dynamical  model  for  the  payload  portion  of  the 
flight  is  required.  The  usual  relationships  between  the  angular  velocities 
of  the  body  and  the  Euler  angles  describing  the  orientation  of  the  body  will 
be  used.  Therefore,  the  previously  defined  coordinate  systems  should  not  be 
confused  with  those  presented  in  this  section. 


The  X V L coordinate  system  is  the  inertial  reference  system  used.  The 

X..  Y ^ Z , system  is  the  body  axes  system.  The  other  systems  indicated 

illustrate  intermediate  phases  in  the  transformation  by  successive  rotations 

from  the  inertial  system  to  the  body  axes  system.  In  general,  a vector  (x, 

in  tile  menial  system  can  be  transformed  to  its  representation  ,x_,  v_. 

0 3 

in  the  body  axes  system  as  follows: 


X3 

* “ 
X 

^3 

= Rx(p)  R2(i)  RlC«) 

y ! 

Z3 

z 

L J 

where  (u)  represents  u right -handed  rotation  through  the  angle  a about  the 
j~axis.  With  the  above  definition  of  holer  angles,  the  dynamical  relation- 
ship between  angular  velocities  and  Luler  angles  is: 


fl  = — : — r-(co  sinp  + to  cosp) 

sini^  y z J 


1 = uiy  cosp  - uiz  sinp  (8.1) 

• cosi  , , 

P = U>  - — : r-(U)  sinp  + to  cosp) 

x siniv  y K z ‘ 

where  (io  , (o  (o  ) is  the  angular  velocity  vector  expressed  in  the  principal 
a y z 

axes  system  (coincident  with  body  axes  system  in  this  case) . 

In  the  possible  situation  in  equations  (8.1)  in  which  sin  i~  u,  a new  set 
of  Euler  angles  will  be  used  in  order  to  avoid  numerical  difficulty.  The  new 
set  is  a longitude-latitude-spin  angle  approach  to  defining  the  Euler  angles. 

In  order  to  maintain  the  usual  convention  of  taking  the  latitude  6 to  be 
positive  in  the  direction  toward  positive  z,  the  following  relation  between 
the  vector's  representations  in  the  inertial  system  and  the  body  axes  system 
is  defined: 


y3  = R2(v)  R2(-6)  R3(A)  y 

z3  2 

J L 
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The  relationship  between  the  angular  velocities  and  the  Euler  angles 

is : 


X = 


j^(uV  sinv  + ^ cosv) 


' = oj  sinv  - ui  cosv 
o z y 


(8. 


sin6 . 

v - ui__  - — sinv  + u cosvj 


ux  co'sS^  y 


In  the  problem  case  when  situ  ~ 0,  there  will  be  no  problem  with  equations 
(6.2)  since  coso  1. 


Solving  ror  one  set  ot  Euler  angles  in  terms  of  the  other  set  is 
accomplished  quite  simply  oy  manipulating  certain  terms  of  the  common  trans- 
formation matrix.  Widen  switching  from  one  set  to  the  other,  the  set  of 
differential  equations  will  be  switched  also. 

The  dynamical  equations  for  the  angular  velocities  are  simply  Euler's 
equat ions : 
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u)  = ~z — [(I  -I  ) u)  + M j 
x I LV  y zJ  y z xJ 


w = 7—  [ (I  -I  ) u>  w ♦ M ] 
y I 1 z x z x yJ 


u)  = 7—  [(I  - 1 ) w u + M 1 . 
z I_  1 x yJ  X y zJ 


(8.3) 


(M  , M , M ) represents  the  torque  which  will  be  modeled  as  the  nominal 
a y z 

output  of  the  thrusters  plus  a random  component.  1,1,  and  I are  the 
principal  moments  of  inertia. 

Since  the  equations  describing  the  dynamical  system  are  non-linear,  they 
will  be  linearized  about  a state  reference  vector.  The  partial  derivatives 
of  the  righthand  sides  of  equations  (8.1),  (8.2),  and  (8.3)  are  practically 
identical  to  the  same  equations  programmed  for  a previous  attitude  determina- 
tion problem. 

The  observations  can  be  directly  related  to  various  elements  of  the  state 
vector.  The  outputs  of  the  rate  gyros  and  the  rate  integrating  gyros  can  be 
directly  compared  with  the  current  estimates  of  the  angular  velocity  vector 
(u>x,  ooz)  since  the  body  axes  rates  are  directly  sensed  by  these  gyros. 

The  angular  sun  and  star  data  will  be  related  to  the  Euler  angles  in  the  same 
manner  as  programmed  for  a previous  attitude  determination  problem.  If  roll, 
pitch,  and  yaw  displacements  from  gyro  null  positions  need  to  be  used,  they 
will  be  related  to  the  Euler  angles  by  comparing  the  transformation  matrix 
based  on  the  sensor  outputs  with  the  transformation  matrix  formed  from  the 
current  estimate  of  the  Euler  angles. 

In  applying  the  Kalman  filter  to  the  system  of  non-linear  state  equations, 
the  standard  linearization  techniques  are  followed.  The  state  equation  is 
expanded  in  a Taylor  series  about  X = Xf^p  and  all  second-  and  higher-order 
terms  are  truncated.  After  subtracting  the  reference  state  equation,  the  state 
residuals  equation  remains: 


x = A(t)  x + B(t)  w 


(8.4) 
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where  x = X-Xrep  A(t)  is  the  matrix  of  partial  derivatives  of  the  right- 
hand  sides  of  equations  (8.1)  or  (8.2)  and  equations  (8.3),  B(t)  is  chosen 
as  a constant  matrix  for  this  problem,  and  w(t)  is  the  random  component  of 
the  torque.  In  accordance  with  the  theory  of  ordinary  differential  equations, 
a solution  for  equation  (8.4)  can  be  written  in  terms  of  the  state  transition 
matrix  $: 

x (t)  = 4>(t,to)  x(t0)  + 4>(t,X)  B(t)  w(t)  dx 

v't0 


A mean  solution  can  be  written: 

x(t)  = H[x(t)]  = <5(t,to)  x(tQ)  ♦ f 4>(t,x)  B(x)  w(t)  dx  . 

J t 

o 

If  the  following  statistical  assumptions  are  made: 

E [w(t)j  = 0 

E #c(to)  - x(tQ))  (x(tQ)  - 7(to))TJ  = P(tQ) 

E lU(to)  - x(to))  (w(t)  - w(t))r]  = 0 
E [(w(t)  - w(t)j  (w(s)  - w(s))1]  = Q(t)  6 (t-s) 

where  d(t-s)  represents  the  Dirac  delta  function;  then  the  variance  solution 
can  be  written: 

P(t)  = E [(x(t)  - x"( t ) ) (x(t)  - x(t))T] 

« *(t,t  ) P(t  ) ♦'(t.t  ) = f $(t,x)  B(x)  Q(x)  BF(x)  $T(t,x)  dx 

Jto 

If  the  variance  solution  is  differentiated,  the  following  differential  equation 
for  P(t)  is  obtained: 

P = AP  + i’A1  + BQB 1 


3D 
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where  the  fact  that  P = P was  used.  This  equation  is  used  to  map  the  state 
covariance  matrix  P from  one  time  to  the  next.  In  mapping  P forward  over 
a small  interval  from  tQ  to  t,  P(tQj  is  known;  A is  computed  from  the  state 
reference  vector,  which  is  integrated  simultaneously;  B is  a constant  matrix; 
and  Q is  an  input  quantity  representing  the  covariance  of  the  state  disturbance. 

A similar  linearization  process  involves  the  observation-state  relational 
equation  at  time  t^. 


Y(t.)  = G(X(ti),ti)  + V;L  (8.5) 

where  Y is  an  m*l  vector-valued  function,  and  v^  is  an  m*l  vector  representing 
noise  associated  with  the  observation.  A reference  observation  is  computed 
using  the  equation. 


WV  = GCWV'V  • 

In  applying  the  Kalman  filter,  the  partial  derivatives  of  G are  required.  This 
matrix  H is  defined  as: 


H = 


3G 

3X 


X = X 


ref 


Equation  (8.5)  is  expanded  in  a Taylor  series  about  X = X and  all  second- 
and  higher-order  terms  are  truncated.  After  subtracting  the  reference 
observation-state  relational  equation,  the  observation  residuals  equation 
remains: 


where 


y = H(t)  x ♦ v 


y = Y 


ref 


The  Kalman  filter  is  applied  in  this  problem  in  accordance  with  the 
following  general  scheme: 


40 


w 


a.  Assume  that  at  time  t^  the  following  quantities  are  available: 

X ^(t^)  state  reference  vector 

P(t^)  = P^  state  covariance  matrix 

The  matrix  P^  gives  a measure  of  the  error  in  the  best  estimate  of  the  state 
vector  at  time  t..  Assume  also  that  P.  is  based  on  q observations  already 

1 i 

processed. 

b.  At  time  t^  (t^  > t.),  a new  data  record  is  processed.  This  data 

record  contains  new  observations  Yjg  at  times  tj^j  respectively  (j  = 1,2 s) 

The  covariance  matrices  Rg j = E [vj^j  v£_j]  (j  = l,2,...,s)  are  also  given. 

c.  The  problem  is  to  find  a best  estimate  of  the  state  vector  X ( t and 
the  associated  covariance  matrix  P^  based  on  (q+s)  observations. 

d.  Map  forward  X .(t  ) to  X ,-(t,  ) and  P(t  ) to  F(t.  ) . Note  that  P(t.  ) 

r ret  1'  ret  k i k k 

Pj.  is  based  only  on  q observations. 

e.  Map  forward  xref(tk)  to  *ref(tkj)  (j  = l,2,...,s).  Compute  the 

corresponding  state  transition  matrices  ‘Ht^-.t..)  (j  = l,2,...,s).  Compute 

the  reference  observations  Y ,.(t,  ;)  = G(X  .(t  .lti  ) and  the  corresponding 

ret^  kJ  ref  kj-'  K.i 

partial  derivatives  H(tgjj  = H^j  (j  = l,2,...,s).  Find  the  observation 
residuals : 


= Ykj  - WV  U = 1«2 s> 


f.  The  following  set  of  relationships  holds: 


ykl  = “kl  xUkl}  + v 


kl 


yk2  = “k2  x^k2J  + Vk2 


v,  H,  x(t,  ) <■  V, 
'ks  ks  ks  ks 
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Equivalently,  this  set  can  be  written: 


ykl  = Hkl  *(tkl»V  x(V  + vkl 
yk2  = Hk2  x(V  * vk2 


= Hks  4(tks*V  x^k^ 


+ 


v 


ks 


y = H x(tk)  + V 


g.  The  Kalman  filter  computes  the  best  estimate  of  the  state  residuals 
vector  x(tk)  and  the  state  covariance  matrix  P^. 


*(tk)  = Kk  y 
P(tk)  = (I  - KkH)  P, 


where 


Kk  = PkHT  [HFkHT  + R] 
R = E [v  vT] 


and  I is  the  identity  matrix. 

A 

h.  The  best  estimate  of  the  state  X(tk)  is  simply: 


X(V  = Xref(tk}  * X(V  • 

1.  In  preparation  for  the  next  step,  Xref(tk) 
and  the  process  continues  with  step  (b) . 


A 

is  redefined  to  be  X(tk) 
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9.  LRROR  analysis 


.An  error  analysis  will  be  performed  to  determine  optimum  data  flow  and 
weighting  criteria  for  individual  probe  outputs.  This  analysis  will  identify 
error  sources,  both  systematic  and  random,  define  the  magnitude  and  resultant 
contributions  of  the  individual  sources,  and  thus  estimate  the  total  errors. 
Included  in  this  study  will  be  expected  random  and  bias  errors  caused  by 
sensor  alignment  tolerances,  timing  uncertainties,  ACS  cross  coupling  errors, 
and  random  as  well  as  systematic  drifts.  Non-random  distributions  will  be 
assumed  so  that  Root  Mean  Square  (RMS)  accuracy  bands  will  be  applicable. 

This  error  analysis  will  allow  us  to  evaluate  the  contributions  of  each 
error  source  to  the  final  output  and  thus  to  determine  which  error  sources 
can  be  ignored,  how  to  minimize  bias  errors  in  the  post  flight  data  analysis 
and  how  best  to  perform  timing  synchronization. 


